/* Drive.h
 *
 *  Created on: Feb 23, 2013
 *      Author: FEAR
 */

#ifndef DRIVE_H_
#define DRIVE_H_

#include "WPILib.h"


class Drive
{
public: 
	Drive(UINT32 leftJoystickChannel, UINT32 rightJoystickChannel, UINT32 leftMotorChannel, UINT32 rightMotorChannel);
	~Drive();
	void HandleDrive();
	void SetDriveSpeed(float leftSpeed, float rightSpeed);
	float GetLeftMotorSpeed() const;
	float GetRightMotorSpeed() const;
	
private:
	Victor * leftMotor;
	Victor * rightMotor;
	Joystick * stick1;
	Joystick * stick2;
	
	void SetMotors(float leftVal, float rightVal);
	float Limit(float num);
};

#endif
